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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Prufungsantrag gem. § 44 PatG 1st gestellt 

© Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters 

® Die vorliegnde Erfindung schafft ein Verfahren zum Er- 
fassen und Kompensieren von kinematischen Verande- 
rungen eines Roboters (10) aufgrund interner und/oder 
externer Einflusse mit den Schritten: Bereitstellen eines 
Robotermodells in Form eines technischen Algorithmus 
mit einem oder mehreren festgelegten Paramtern, wel- 
che die theoretische raumliche Stellung des Roboters (10) 
in Abhangigkeit von einer oder mehreren SteuergroRen 
beschreibt; Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit einer Robotersteuerung (100) 
gemaft dem Robotermodell; Erfassen der tatsachlichen 
raumlichen Iststellung des Roboters (10) im Betrieb durch 
eine Sensoreinrichtung (K 1f K 2 ; 50); Erfassen der kinema- 
tischen Veranderungen anhand der Abweichung der er- 
faSten tatsachlichen raumlichen Iststellung des Roboters 
i (10) von der theoretischen raumlichen Sollstellung des 
, Roboters (10); Anpassen des oder der Parameter des Ro- 
• botermodells zum Kompensieren der kinematischen Ver- 
anderungen unter Berucksichtigung der erfafcten Abwei- 
chung; und Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit der Robotersteuerung (100) ge- 
maft dem Robotermodell mit dem oder den angepafcten 
Para mete rn. 
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Beschreibung 

Die voriicgendc Erfindung bctriffl cin Vcrfahren zum Erfassen und Kompensieren von kinematischen Veranderungen 
eines Roboters aufgrund interner und/oder externer Einfliisse. 
5 Solche kinematischen Veranderungen beeinflussen insbesondere die Positionierbarkeit des Roboters und ruhren von 
internen EinfluBfaktoren, wie z. B. Alterung, VerschleiB, Derformation, . . und externen Faktoren, wie z. B. Tempera- 
tur, Druck, Lastwechscl, . . her. 

Obwohl auf beliebige Roboter anwendbar, werden die vorliegende Erfindung sowie die ihr zugrundeliegende Proble- 
matik in bezug auf einen Industrieroboter zur Vermessung von Fahrzeug-Karosserieteilen erlautert. 
10 Allgemein koiiunen fur die Vermessung von Bauteilen, insbesondere Fahrzeug-Karosserieteilen in der Automobilin- 
dustrie, zunehmend Industrieroboter zum Einsatz. Diese Roboter sind mit einem beispielsweise optischen MeBsystem 
ausgestattet und konnen sehr flexibel fur komplizierte MeBaufgaben, insbesondere an schwer zuganglichen Stellen ein- 
gesetzt werden. Fiir eine gleichbleibend gute Qualitat solcher Messungen ist es erforderlich, daB die kinematischen Ver- 
anderungen des Roboters keinen oder nur einen verschwindend geringen EinfluB auf die Messungen haben. 
15 Der Idealzustand ware, wenn sowohl innere Effekte, wie z. B. Abnutzungserscheinungen, als auch auBere ErTekte, wie 
z. B. Temperaturschwankungen der MeBumgebung, kompensierbar waren. 

Dies ist jedoch bei den heutzutage bekannten Systemen nicht moglich. Vielmehr ist man darauf angewiesen, die Ab- 
nutzungserscheinungen, Temperatureinflusse usw. direkt zu erfassen und zu kompensieren. Beispielsweise sind somit 
eine haufige Nachjustage der Mechanik des Roboters und eine Klimatisierung der MeBumgebung notwendig. Diese Vfor- 
20 gehensweise ist Zeit- und kostenaufwendig. 

Die DE 196 16 276 Al beschreibt ein Verfahren und eine Vorrichtung zum Vermessen und Kalibrieren eines mehrach- 
sigen Industrieroboters mit einer Vermessungseinrichtung, welche aus einem MaBkorper und einer MeBvorrichtung be- 
steht. Der MaBkorper und der Roboter haben einen gemeinsamen Bezugsort, an dem sie losbar und austauschbar ange- 
ordnet sind. An diesem Bezugsort wird zunachst der MaBkorper vermessen, anschlieBend gegen den Roboter ausge- 
25 tauscht und an der Roboterhand befestigt. Der Roboter wird in eine Grundposition mit angenommener Nullstellung sei- 
ner Achsen bewegt, dort vermessen und anschlieBend in eine vorgegebene MeBposition gefahren, in der der MaBkorper 
erneut vermessen wird. AnschlieBend werden die Istlage des MaBkorpers in der MeBposition und seine Soilage vergli- 
chen, wobei aus den Lageabweichungen die Stellungsdifferenzen zwischen angenommener und tatsachlicher Nullstel- 
lung des Roboters ermittelt werden. Unter Berucksichtigung der Stellungsdifferenzen wird dann der Roboter in die tat- 
30 sachliche Nullstellung gefahren und mit seinen Achsen dort kalibriert. 

Bei diesem bekannten Verfahren wird jedoch nur einmalig die tatsachliche Nullstellung ermittelt, ohne daB die Ein- 
fliisse von kinematischen Veranderungen des betreffenden Roboters oder seiner Umgebung auf die zugehorige Roboter- 
steuerung beriicksichtigt werden. 

Eine Aufgabe der vorliegenden Erfindung besteht darin, ein verbessertes Verfahren zur Kompensation der Einfliisse 
35 von kinematischen Veranderungen eines Roboters oder seiner Umgebung auf eine zugehorige Robotersteuerung zu 
schaffen, welches solche ungewiinschten Einfliisse erfassen und kompensieren kann. 

ErfindungsgemaB wird diese Aufgabe durch das in Anspruch 1 angegebene Verfahren gelost. 
. Das erfindungsgemaBe Verfahren weist gegeniiber den bekannten Losungsansatzen den Vorteil auf, daB es eine robu- 
ste Methode zur Erfassung und Kompensation von kinematischen Veranderungen liefert, die unabhangig von den Ursa- 
40 chen der Veranderungen arbeitet. Durch das beschriebene Verfahren wird der Roboter in die Lage versetzt, wahrend sei- 
ner gesamten Lebensdauer in seiner realen Arbeitsumgebung - in einem definierten Arbeitsraum - seine physisch vor- 
gegebene wiederholgenauigkeit zu bewahren. Auftretende Fehlereinfliisse werden durch das erfindungsgemaBe \ferfah- 
ren systematisch erfaBt und permanent kompensiert. 

Damit ergeben sich uberall dort neue Einsatzgebiete des Roboters, wo bisher aufgrund externer oder interner Einfliisse 
45 die erforderliche langzeitige Positioniergenauigkeit nicht erreicht werden konnte. 

Die der vorliegenden Erfindung zugrundeliegende Idee besteht darin, daB der Roboter bzw. Posen des Roboters im ge- 
samten Arbeitsraum vermessen werden. Die Posen werden abhangig von der Aufgabenstellung durch einen technischen 
Algorithmus optimiert beschrieben. Jeder oder bestimmten vorgegebenen Posen (Sollwert) wird beim Betrieb ein Istwert 
zugeordnet. Diese Parchen von Soll/Istdaten dienen als Input fiir eine Prozedur zur Parameteranpassung bzw. -optimie- 
50 rung. Durch die Paraineteroptimierung werden die kinematischen Veranderungen kompensiert. 

Die Ergebnisse konnen dauerhaft oder temporar in der Robotersteuerung abgelegt werden, und bei Bedarf konnen die 
erforderlichen Anpassungen unternommen werden. So werden auftretende reale Abweichungen funktional kompensiert 
und das Positioniervermogen trotz sich andemder Randbedingungen bzw. trotz zunehmendem VerschleiB erhalten. 
Die Erfassung der Abweichungen und deren Kompensation im Betrieb heiBt entweder im Realbetrieb oder im Simu- 
55 lationsbetrieb oder bei bei den. 

In den Unteranspriichen finden sich vorteilhafte Weiterbildungen und Verbesserungen des in Anspruch 1 angegebenen 
Verfahrens. 

GemaB einer bevorzugten Weiterbildung erfolgt das Anpassen des oder der Parameter des Robotermodells zur Kom- 
pensation der kinematischen Veranderungen unter Berucksichtigung der erf aB ten Abweichung, wenn die erfaBte Abwei- 
60 chung einen vorbestimmten Wert uberschreitet. Dies ist jedoch nicht die einzige Moglichkeit, vielmehr konnen z. B. 
auch Trends verfolgt werden und erst nach mehreren Uberschreitungen Anpassungen eingeleitet werden. 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Bereitstellen eines Robotermodells in Form eines tech- 
nischen Algorithmus mit einem oder mehreren festgelegten Parametern durch Anbringen eines MaBkorpers an der Ro- 
boterhand; Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers durch die Sensoreinrichtung an einer Viel- 
65 zahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten und durch Fesdegen des oder der 
Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters an den Referenzpunkten in Abhangigkeit 
von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens eine Kamera verwendet, 
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welche extern aufgestellt ist^J^F 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens ein Lageerfassungssen- 
sor vcrwcndct wird, wclcher an dcr Roboterhand angebrachl ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird das Erfassen der kinematischen Veranderungen anhand der 
Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters von der theoretischen raumlichen Sollstel- 5 
lung des Roboters an den Referenzpunkten durchgefiihrt, indem ein jeweiliger Korrekturvektoren zwischen der erfaBten 
tatsachlichen raumlichen Iststellung des Roboters und dem entsprcchcndcn Rcfercnzpunkt eingefuhrt wird. 

GemaB einer weiteren bevorzugten Weiterbildung wird die tatsachlichen raumliche Iststellung des Roboters im Be- 
trieb durch die Sensoreinrichtung mittels eines am Roboter angebrachten MaBkorpers ermittelt wird. Durch die MaBkor- 
pervermessung werden die Basis und das Tool unabhangig von der cigenen Kincmatik des Roboters geschatzt, und somit to 
gehen auch seine Fehler nicht in die Schatzung ein. 

GemaB einer weiteren bevorzugten Weiterbildung wird die Gute der im Betrieb durch die Sensoreinrichtung erfaBten 
tatsachlichen raumlichen Iststellung des Roboters ermittelt wird und das Anpassen davon abhangig gemacht wird. Somit 
gehen als Import fur die Parameteranpassung nur guitige bzw. zuverlassig crmittelte Daten ein, und AusrciBer sind cli- 
minierbar. 15 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Ermitteln der Giite durch Bereitstellen eines MaBkorpers 
mit Markern am Roboter; Festlegen eines inneren Koordinatensy stems auf dem MaBkorper und der entsprechenden Ko- 
ordinaten der Marker; Erfassen dcr Koordinaten dcr Marker im Weltkoordinatensystern durch die Sensoreinrichtung; op- 
timiertes Abbilden der Koordinaten der Marker im inneren Koordinatensystems auf die Koordinaten der Marker im 
Weltkoordinatensystern und durch Ermitteln der Giite anhand des mittleren Fehlers der Abbildung. Diese \fcrgehens- 20 
weise liefert eine qualitative Aussage uber die Giite der MeBdaten. 

Ausfuhrungsbeispiele der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden Beschreibung na- 
her erlautert. 

Es zeigen: 

Fig. 1 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform des 25 
erfindungsgemaBen Verfahrens; 

Fig. 2 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens; und 

Fig. 3 eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten Aus- 
fuhrungsform des erfindungsgemaBen Verfahrens. 30 

In den Figuren bezeichnen gleiche Bezugszeichen gleiche oder funktionsgleiche Komponenten. 

Fig. 1 zeigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens. 

In Fig. 1 bezeichnet Bezugszeichen 10 einen an seinem Einsatzort fest montierten Roboter, 15 einen Roboterarm, 18 
eine (verdeckte) Roboterhand, 20 einen MaBkorper, R Referenzpunkte auf dem MaBkorper 20, 50 einen Lageermitt- 35 
lungssensor, welcher mit dem MeBpunkt 55 zusammenwirkt, K t und K 2 eine erste bzw. zweite externe Kamera, welche 
den MaBkorper in ihrem gemeinsamen Sichtbereich haben, 100 eine Robotersteuerung und 120 einen Hostrechner. Die 
Roboterhand 18 ist zusatzlich mit einem (nicht gezeigte) Werkzeug, z. B. einem MeBvideosensor, bestiickt. Mit diesem 
Systemaufbau ist man prinzipiell in der Lage, einerseits mit dem Roboter 10 Messungen vorzunehmen und andererseits 
die Position und Orientierung des MaBkorpers 20 zu bestimmen. 40 

In Form eine Steuerprogramms existiert in der Robotersteuerung ein Robotermodell in Form eines technischen bzw. 
physikalisch/mathematischen Algorithmus mit einem oder mehreren festgelegten Parametern, welches die theoretische 
raumliche Stellung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt. Als Parameter 
kommen beispiels weise Linklangen, Achsenschiefstande, Nullpunktfehler, Gelenklose, Gelenkelastizitaten usw. in 
Frage. 45 

Mittels dieses Modelis und einer entsprechend modifizierten Kinematik ist der Roboter 10 in der Lage, kartesische Po- 
sitionen in seinem Arbeitsraum mit hoher Genauigkeit zu erreichen. 

Im folgenden wird naher erlautert, wie der oder die Parameter fur das Robotermodell festgelegt werden. Zum Zeit- 
punkt der Inbetriebnahme befindet sich der Roboter 10 in einer bestimmten kinematischen Konfiguration, die von den 
besagten internen und externen EinfluBfaktoren abhangig ist. Diese Referenzkonfiguration wird iiber eine Referenzmes- 50 
sung festgehalten, indem der MaBkorper 20 an ausreichend vielen raumlichen Roboterstellungen (entsprechend Refe- 
renzpunkten ai mit i = 1 . . . n), welche durch die SteuergroBen bestimmt werden, durch die eine erste und zweite exteme 
Kamera K L bzw. K 2 vermessen wird. Darauf erfolgt das Festlegen des oder der Parameter derart, daB das Robotermodell 
die raumliche Stellung des Roboters 10 an den Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit ei- 
ner bestimmten sehr hohen Genauigkeit beschreibt. Hoch bedeutet dabei, daB die Genauigkeit groBer ist als die aufgrund 55 
der kinematischen Veranderungen auftretenden Schwankungen. 

Andert sich nun die Referenzkonfiguration, d. h. treten kinematische Veranderungen des Systems auf, werden die Re- 
ferenzpunkte ai nicht mehr mit der sehr hohen Genauigkeit anfahrbar sein, welche durch die Referenzmessungsparame- 
ter bestimmt ist, sondern es werden sich Ab weichungen zwischen Soli- und Istwerten ergeben, welche mittels der beiden 
Kameras Ki, K 2 und/oder dem Lagesensor 50 erfaBt werden. 60 

Aufgrund der jeweiligen Abweichung zwischen Sollwert Fj, und Istwert F*i wird eine Anpassung des oder der Para- 
meter des Robotermodells ausgelost, namlich bei dieser Ausfuhrungsform, wenn die erfaBte Abweichung einen vorbe- 
stimmten Wert uberschreitet. 

Diese Anpassung geschieht dadurch, daB ein jeweiliger Korrekturvektoren Tj zwischen der erfaBten tatsachlichen 
raumlichen Iststellung F*i des Roboters 10 und dem entsprechenden Referenzpunkt als Sollwert Fj eingefuhrt wird. Es 65 
gilt dabei die funktionelle Beziehung: 

T(M, ai ) • Tj = F| (1) 
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wobei die Korrekturvel^Rn Tj den Fehler T(M, a^" 1 F> zwischen dem theoretischen <X^Rrt T(M, und der Referenz- 
messung Fi beschreiben, wobei M das urspriingliche Computermodell ist. 

Der zenlralc Teil der Anpassung bcsteht nun darin, daB ursprungliche Robotermodeil M mil dem oder den ursprungli- 
chen Parametern in ein angepaBtes Robotermodeil M* nut einem oder mehreren angepaBten Parametern umzuwandeln. 

Diese Aufgabe fuhrt auf ein nicht-lineares Minimierungsproblem der Form: 

n 

I |T(M*,ai) - Fi* T" 1 f 2 = min. (2) 
i = l 
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Die Losung dieses Minimierungsproblems erfolgt zweckmaBigerweise mittels der GauB-Newton-Methode. 
Durch die Einfuhrung der Korrekturvektoren gelingt es also, die Fehler zu quantisieren und zu kompensieren, welche 
auf kinematischen Anderungen der Referenzkonfiguration beruhen. Dabei werden nichtdie EinfluBfaktoren, sondern de- 
ren Wirkung erfaBt. Lctztere sind also unerheblich, da der Roboter 10 lediglich auf scin ursprungliche s Verhalten zuruck- 
15 gefiihrt wird. 

Das Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Ro- 
botermodeil mit dem oder den angepaBten Parametern erfolgt dann solange, bis die erfaBten Abweichungen eine erneute 
Anpassung erforderlich machen. 

GemaB einer Weiterbildung der ersten Ausfuhrungsform wird nun eine robuste und reproduzierbare Prozedur angege- 
20 ben, durch die die Position und die Qrientierung eines MaBkorpers bzw. MeBwerkzeuges im kartesischen Raum hochge- 
nauermittelt werden kann. Die Prozedur benotigt neben den MeBwerten ein internes Koordinatensystem, in dem die 
MeBmerkmale a priori bestimmt wurden, als EingangsgroBen. Im weiteren Verlauf der Prozedur entsteht eine Koordina- 
tentransformation vom Weltkoordinatensystem zum MeBwerkzeugskoordinatensystem durch eine optimale Anpassung 
der erhaltenen MeBwerte. 

25 Uber die bekannten Abstande der MeBmerkmale untereinander wird die Giite der MeBdaten laufend eindeutig kontrol- 
liert, also nicht nur nach ihrer Plausibilitat, sondern genau quantisierbar. Somit konnen AusreiBer der MeBdaten, konkret 
der gemessenen Istwerte der raumlichen Position des Roboters 10, eliminiert werden und verhindert werden, daB die irr- 
tiimlicherweise eine Anpassung des oder der Modellparameter auslosen. 

Im einzelnen bestehtderMaBkorper aus einer stabilen Vorrichtung zum Anbringen von MeBmerkmalen (sog. Marker). 

30 Hierbei sind verschiedene Variationen von einer Metallplatte bis hin zu einzelnen Verstrebungen vorstellbar. Wichtig ist 
allein die geometrische Invarianz, also Stabilitat gegenuber Verformungen, 

Das interne Koordinatensystem bzw. MeBwerkzeugskoordinatensystem des MaBkorpers entsteht aus einer Messung 
der MeBmerkmale, die darauf in ausreichend groBen Abstanden angebracht sind. Diese Messung erfolgt unter optimalen 
Bedingungen und liefert alle Markerpositionen im internen Koordinatensystem mit willkurlich definiertem Ursprung. 

35 Eine Schatzung liefert die Position und Orientierung des MaBkorpers, der am Roboter 10 angebracht ist, bezugiich des 
Weltkoordinatensystems, wie z. B. erfaBt durch die extemen Kameras K t und K 2 . Die extern erfaBten MeBwerte y t bilden 
mit den entsprechenden bekannten Koordinaten Xi des intemen Koordinatensystems die Eingangsdaten fur diese Schat- 
zung. Man sucht nun eine Abbildung A bestehend aus einem Translationsanteil (a, b, c) und einem Rotationsanteil (a, P, 
y), welche jedes Urbild x L , auf den entsprechenden MeBwert yj abbildet. Dieser Ansatz laBt sich mit der Methode der 

40 kleinsten Fehlerquadrate losen, namlich gemaB der Beziehung: 

n 

Z | A(a,b,c;a,p,y)Xi - yi| 2 = min. (3) 
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Der mittlere Fehler der Abbildung liefert dann ein MaB fur die gesuchte Giite. 
Fig. 2 zeigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungs- 
form des erfindungsgemaBen Verfahrens. 

In Fig. 2 bezeichnen zusatzlich zu den bereits eingefiihrten Bezugszeichen KC eine KamerasteuerungsAauswertung- 
50 einrichtung, 150 einen MeBvideosensor, 200 ein MeBobjekt in Form einer Fahrzeugkarosserie und PA eine MeBvideo- 
sensorsteuerungs/-auswertungeinrichtung. 

Der in Fig. 2 gezeigte Systemaufbau dient zur genauen Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideo- 
sensor 150 unter Manipulation durch den Roboter 10. 

Zunachst wurde ein Robotermodeil mit mehreren festgelegten Parametern, welches die theoretische raumliche Stel- 
55 lung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt, vorgegeben. Es erfolgte dann 
ein Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung 100 gemaB diesem Robo- 
termodeil und dabei eine Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150. 

Dann wurde das derart aufgebaute MeBsystem thermischen StreBfahrten mit einem Temperaturhub von 20°C unter- 
worfen. 

60 Es folgte ein Erfassen der tatsachlichen raumlichen Iststellung des Roboters 10 im Simulationsbetrieb durch die Sen- 
soreinrichtung in Form der Kameras K t , K 2 . Wie erwartet ergabt sich das Vorhandensein kinematischer Veranderungen 
als Folge der thermischen StreBfahrten. Es folgte eine erneute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvi- 
deosensor 150 (unkompensierte Daten in Fig. 3). 

Es folgte darauf Anpassen der Parameter des Robotermodells zum Kompensieren der kinematischen \eranderungen 
65 unter Beriicksichtigung der erfaBten Abweichung und ein Steuern der theoretischen raumlichen Sollstellung des Robo- 
ters mit der Robotersteuerung gemaB dem Robotermodeil mit dem oder den angepaBten Parametern und dabei eine er- 
neute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 (kompensierte Daten in Fig. 3). 

Fig. 3 zeigt eine Darstellung der Haufigkeit von MeBabweichungen beim iiblichen Verfahren im Vergleich zur zweiten 
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Ausfiihrungsform des erfindH^emaBen Verfahrens. 

Wie deutlich aus Fig. 3 erkennbar, zeigen die unkompensierten Daten eine Abweichung von bis zu etwa 0,390 mm ge- 
genubcr der erslcn Mcssung vor den thermischen SlreBfahrten. Dcnigegeniiber zeigen die kompensierLen Daten lediglich 
eine Abweichung von bis zu etwa 0,125 mm gegenuber der ersten Messung vor den thermischen StreBfahrten. Die Kom- 
pensation schafft also eine Verbesserung urn einen Faktor 3. 5 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzugter Ausfuhrungsbeispiele beschrieben wurde, ist sie 
darauf nicht beschrankt, sondcrn auf vielfaltige Art und Weise modifizierbar. 

Insbesondere sind genannten Anwendungen nur beispielhaft und beliebig verallgemeinerbar. Auch ist die Positionser- 
fassung nicht auf Kameras beschrankt. Der MaBkorper muB nicht ein selbstandiger Korper sein, sondern kann in den Ro- 
boter intcgriert sein. Auch die genannten Algorithmen diencn nur Illustrationszwecken und konnen durch andcre gceig- to 
nete Optimierungsalgorithmen ersetzt. werden. 

Bezugszeichenliste 

10 Roboter 15 
100 Robotersteuerung 
50 Sensor 

55 MeBpunkt fur Sensor 50 
15 Roboterarm 

18 Roboterhand 20 
20 MaBkorper 
Ki Kamera 1 
K2 Kamera 2 

KC Kamerasteuerungs/-auswertungeinrichtung 

150 MeBvideosensor 25 

200 MeBobjekt, Fahrzeugkarosserie 

PA MeBvideosensorsteuerungsAauswertungeinrichtung 

R Referenzpunkt auf 20 

120 Hostrechner 
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1. Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters (10) aufgrund in- 
terner und/oder externer Einfliisse mit den Schritten: 

Bereitstellen eines Robotermodells in Form eines technischen Algorithmus mit einem oder mehreren festgelegten 35 
Parametern, welches die theoretische raumliche Stellung des Roboters (10) in Abhangigkeit von einer oder mehre- 
ren SteuergroBen beschreibt; 

Steuem der theoretischen raumlichen Sollstellung des Roboters mit einer Robotersteuerung (100) gemaB dem Ro- 
botermodell; 

Erfassen der tatsachlichen raumlichen Iststellung des Roboters (10) im Betrieb durch eine Sensoreinrichtung (Ki, 40 
K 2 ;50) 

Erfassen der kinematischen Veranderungen anhand der Abweichung der erfafiten tatsachlichen raumlichen Iststel- 
lung des Roboters (10) von der theoretischen raumlichen Sollstellung des Roboters (10); 

Anpassen des oder der Parameter des Robotermodells zum Kompensieren der kinematischen Veranderungen unter 
Beriicksichtigung der erfaBten Abweichung; und 45 
Steuem der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Robo- 
termodell mit dem oder den angepaBten Parametern. 

2. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, daB das Anpassen des oder der Parameter des Robotermo- 
dells zur Kompensation der kinematischen Veranderungen unter Beriicksichtigung der erfaBten Abweichung er- 
folgt, wenn die erfaBte Abweichung einen vorbestimmten Wert iiberschreitet. 50 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB das Bereitstellen eines Robotermodells in Form 
eines technischen Algorithmus mit einem oder mehreren festgelegten Parametern folgendermaBen erfolgt: 
Anbringen eines MaBkorpers (20) an der Roboterhand (18); 

Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers (20) durch die Sensoreinrichtung (K L , K 2 ; 50) an 
einer Vielzahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten; und 55 
Festlegen des oder der Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters (10) an den 
Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 
(Ki, K 2 ; 50) mindestens eine Kamera (Ki, K2) verwendet wird, welche extern aufgestellt ist. 

5. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 60 
(Ki, K 2 ; 50) mindestens ein Lageerfassungssensor (50) verwendet wird, welcher an der Roboterhand (18) ange- 
bracht ist. 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB das Erfassen der kinemati- 
schen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) 
von der theoretischen raumlichen Sollstellung des Roboters (10) an den Referenzpunkten durchgefuhrt wird, indem 65 
ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) und 
dem entsprechenden Referenzpunkt eingefuhrt wird. 

7. Verfahren nach einem der vorhergehenden Ansprtiche, dadurch gekennzeichnet, daB die tatsachlichen raumliche 



5 



A DE 198 26 395 A 1 ^ 

Iststellung des Robolrs (10) im Betricb durch die Sensoreinrichtung (K t , K 2 ; 50^Hls eines am Roboter (10) an- 
gebrachten MaBkorpers (20) ermittelt wird. 

8. Verfahren nach eincm der vorhergehcnden Anspriiche, dadurch gckcnnzeichnet, da6 die Gute der im BcLricb 
durch die Sensoreinrichtung (K t , K 2 ; 50) erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) ermittelt 
wird und das Anpassen davon abhangig gemacht wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnet, daB das Ermitteln der Gute folgendermaBen erfolgt: 
Bereitstellen eincs MaBkorpers (20) mit Markcrn (R) am Roboler (10); 

Festlegen eines inneren Koordinatensy stems auf dem MaBkorper und der entsprechenden Koordinaten der Marker 

(R); 

Erfassen der Koordinaten der Marker (R) im Weltkoordinatensystem durch die Sensoreinrichtung (K it K 2 ; 50); op- 
timiertes Abbilden der Koordinaten der Marker (R) im inneren Koordinaten systems auf die Koordinaten der Marker 
(R) im Weltkoordinatensystem; und 

Ermitteln der Gute anhand des mittleren Fehlers der Abbildung. 

10. Robotersteuerung (100) zur Durch fuhrung des Verfahrens nach mindestens cinem der vorhergehenden Ansprii- 
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